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Calculate error 
e=liVo-f {pm 
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K=k+1 
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Updata equation: p^+ispk+Apk 
Ap'<=-{[f'(pk)]Tf(pk)}-i[f(p'<)]T[f(p'<)-Vo] 
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